float64[12] x_robot
float64[12] y_robot